#include <iostream>
#include "move_planner.h"
#include <gtest/gtest.h>

using namespace std;

//TEST(HelloTest, BasicAssertions) {
//    // Expect two strings not to be equal.
//    EXPECT_STRNE("hello", "world");
//    // Expect equality.
//    EXPECT_EQ(7 * 6, 42);
//}

int main() {
    std::cout << "Hello, World!" << static_cast<int>(StepStatus::SENSOR) << std::endl;
    HisStep hisStep;

    Step step = getStep(12.1, 18.1, 1.5, hisStep);
    cout << "1.-----" << step << endl;
    step = getStep(12.1, 18.1, 0, hisStep);
    cout << "2-----"<< step << endl;
    //在X轴反复调整
    step = getStep(12.1, 0, 0, hisStep);
    cout << "3-----" << step << endl;
    step = getStep(9, 0, 0, hisStep);
    cout << "4-----" << step << endl;

    step = getStep(5, 8.5, 0, hisStep);
    cout << "5-----" << step << endl;
    step = getStep(3, 8.5, 0, hisStep);
    cout << "6-----" << step << endl;

    step = getStep(1, 1, 0, hisStep);
    cout << "7-----" << step << endl;
    return 0;
}
